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Abstract 

Feedback  control  laws  for  controlling  multiple  unmanned  surface  ve- 
hilces  in  arbitrary  formations  are  proposed.  The  presented  formation  con¬ 
trol  method  uses  only  local  sensor-based  information.  The  method  of  input- 
output  linearization  has  been  used  to  exponentially  stabilize  the  relative 
distance  and  orientation  of  neighboring  vehicles  with  a  three-degree-of- 
freedom  dynamic  model.  It  is  shown  that  the  internal  dynamics  of  the 
system  is  also  stable.  The  use  of  these  control  laws  is  demonstrated  by 
computer  simulations.  These  controllers  can  be  utilized  to  control  an  ar¬ 
bitrarily  large  number  of  unmanned  vehicles  moving  in  very  general  for¬ 
mations. 


1  Introduction 

During  the  last  several  years,  researchers  have  investigated  the  formation  con¬ 
trol  problem  for  different  type  of  vehicles,  including  indoor  mobile  robots,  out¬ 
door  ground  vehicles,  aerial  vehicles,  and  underwater  and  surface  vehicles.  The 
robotic  research  literature  are  richer  in  this  regard.  Researchers  of  this  field 
have  used  kinematic  models  of  holonomic  robots  and  proposed  feedback  con¬ 
trol  laws  to  control  the  group  of  robots  such  that  they  capture/enclose  a  target 
by  making  troop  formations  [1].  In  this  method,  the  robots  do  not  maintain 
a  predefined  formation  during  the  motion.  They  change  their  formation  au¬ 
tonomously  to  surround  a  target.  Other  researchers  in  the  robotics  field  have 
implemented  a  set  of  elementary  behaviors  (obstacle  avoidance  and  formation 
maintaining  behaviors)  to  control  team  formations.  They  have  designed  a  fuzzy 
controller  based  on  holonomic  kinematic  models  for  each  behavior.  The  overall 
response  of  the  robot  was  the  weighted  superposition  of  each  behavior  [2]. 
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Also,  investigators  have  considered  three  sets  of  geometric  parameters  to 
describe  the  configuration  of  a  robot  team.  One  set  defines  the  gross  position 
of  a  lead  robot,  a  second  set  describes  the  relative  positions  of  the  robots,  and 
a  third  set  determines  the  local  relations  of  the  neighboring  robots.  They  have 
used  a  nonholonomic  kinematic  model  for  the  robots  and  designed  nonlinear 
feedback  controllers  [3]. 

Researchers  have  recently  designed  decentralized  feedback  laws  for  a  forma¬ 
tion  of  unmanned  aerial  vehicles  (UAVs).  They  have  treated  the  dynamic  model 
of  the  formation  structure  as  an  interconnected  system  with  overlapping  subsys¬ 
tems.  They  have  designed  a  static  state  feedback  controller  for  each  subsystem 
based  on  their  perturbed  nominal  dynamics  [4]. 

Some  researchers  have  considered  the  formation  control  problem  for  un¬ 
manned  underwater  vehicles  (UUVs).  They  have  presented  a  biologically  in¬ 
spired,  decentralized  methodology  for  moving  a  loose  formation  of  UUVs  with 
the  goal  of  minimizing  outside  guidance  [5].  Others  have  proposed  an  integrated 
acoustic  navigation  system  and  coordination  control  maneuver  for  a  formation 
of  three  UUVs  and  one  surface  craft  [6]. 

Naval  researchers  have  investigated  decentralized  formation  control  schemes 
for  a  fleet  of  vessels  with  a  small  amount  of  intervessel  communication  [7]. 
In  their  approach,  each  vessel  maintains  its  position  in  the  formation  relative 
to  a  Formation  Reference  Point,  which  follows  a  predefined  path.  They  have 
constructed  an  individual  parametrized  path  for  each  vessel  so  that  when  the 
parametrization  variables  are  synchronized,  the  vessels  axe  in  formation. 

In  the  current  paper,  the  problem  of  control  and  coordination  for  many 
unmanned  surface  vehicles  moving  in  formation  is  investigated.  The  overall 
motion  plan  for  a  single  unmanned  lead  vehicle,  which  can  be  a  virtual  vehicle, 
is  assumed.  The  dynamic  models  of  the  vehicles  are  considered  for  designing 
the  controllers.  It  consists  of  the  surge,  sway,  and  yaw  degrees  of  freedom.  It  is 
assumed  that  two  independent  actuators  drive  the  vehicle. 

Two  nonlinear  decentralized  schemes  are  designed  for  feedback  control  within 
a  formation.  In  the  first  scheme,  one  vehicle  controls  its  relative  distance  and 
orientation  with  respect  to  a  neighboring  vehicle.  In  the  second  scheme,  a  vehicle 
maintains  its  position  in  the  formation  by  maintaining  specified  distances  from 
two  neighboring  vehicles,  or  from  one  vehicle  and  an  obstacle.  The  idea  of 
controlling  relative  distances  is  adapted  from  robotics  research  [3] . 

The  proposed  control  schemes  use  only  local  sensor-based  information.  Feed¬ 
back  linearization  method  is  used  and  it  is  shown  that  the  relative  distances  and 
orientations  of  the  vehicles  are  exponentially  stabilized.  The  stability  of  zero 
dynamics  of  the  system  is  also  discussed.  These  control  laws  have  the  advantage 
of  providing  easily  computable,  real-time  feedback  control,  with  provable  per¬ 
formance  for  the  entire  system.  Numerical  simulations  are  presented  to  demon¬ 
strate  the  efficiency  of  these  techniques. 
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Figure  1:  A  3  DOF  Dynamic  Model  of  a  Vehicle 


2  Dynamics  of  a  Surface  Vehicle 

This  sections  presents  the  dynamic  model  of  a  vehicle,  shown  in  Fig.  1.  Three 
degrees  of  freedom,  surge,  sway,  and  yaw,  are  assumed  for  each  vehicle,  u,  v, 
and  r,  denote  the  speeds  of  these  DOFs  in  local  coordinate  system  respectively. 
A  propeller  and  a  rudder,  or  two  independent  thrusters  can  provide  the  driving 
force  and  steering  torque  for  the  system.  The  force  and  torque  are  denoted  by 
F  and  T  respectively.  Note  that  in  each  case  only  two  independent  actuations 
are  available  for  each  3  DOF  vehicle.  Therefore  the  vehicle  is  an  underactuated 
dynamic  system,  and  the  stability  of  its  zero  dynamics  becomes  a  concern. 

It  has  been  shown  that  with  the  assumptions  of  constant  inertia,  an  elliptical 
vehicle  body,  negligible  higher  order  damping  terms,  and  simplification  of  the 
hydrodynamics,  the  following  equations  describe  the  dynamics  of  the  vehicle  in 
the  local  coordinate  system  [8]. 

m\\u  —  m-z-zvr  +  dn'a  =  F 

m-2-2V  +  mnur  +  d-2-2'V  =  0  (1) 

m-iiT  +  (m-2-2  -  mu)uv  +  dj-jr  =  T 


rriij ’s  are  the  mass  and  moment  of  inertia  of  the  vehicles  including  the  hyro- 
dynamic  added  mass  and  moment  of  inertia,  and  dy’s  are  the  damping  coef¬ 
ficients.  One  can  use  the  kinematic  relations  between  the  speeds  in  local  and 
global  coordinate  systems  and  obtain  the  dynamic  equations  in  terms  of  the 
global  coordinates  as: 


£=T^(U+FcO) 

y  =  7kAfv  +  F*V 


(2) 


where  c  =  cos,  s  =  sin,  and, 


fx  —  m,  d-22V  s 0  —  dii  it  e#  +  9(v  c 9  —  mTu  s9)md 
fy  =  —mrd-22V  c 0  -  dnu  s9  +  9(v  s 9  +  mTu  d))mi  (3) 

fe  =  -mduv  -  d-i-i9 
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and, 


md  =  77122  ~  "‘11 


mr 


_  mil 

m22 


Equations  (2)  and  (3)  describe  the  dynamics  of  the  vehicles  in  terms  of  the 
global  coordinate  components. 


3  Formation  Control  Schemes 

The  bulk  motion  of  the  group  of  vehciles  can  be  characterized  by  trajectory 
planning  and  obstacle  avoidance  algorithms,  for  example,  the  method  of  artificial 
potential  fields  [9].  It  is  assumed  that  a  hypothetical  vehicle  as  a  group  leader 
adapts  the  bulk  motion  of  the  group  as  its  planned  trajectory  and  other  vehicles 
of  the  group  follow  either  the  hypothetical  group  leader  or  their  neighboring 
vehicles.  Therefore,  our  attention  is  focused  on  controlling  the  internal  geometry 
of  the  formation.  Two  types  of  feedback  controllers  are  designed  for  controlling 
the  internal  geometry. 

The  first  feedback  controller  is  called  the  l  -  ip  controller.  It  controls  the 
relative  distance  and  view  angle  of  a  vehicle  with  respect  to  a  neighboring  ve¬ 
hicle.  This  situation  is  applicable  to  all  formations  in  which  each  vehicle  sees 
one  neighbor.  Thus  it  can  be  used  for  vehicles  marching  in  a  single  file  or  at  an 
edge  of  the  formation  geometry. 

Note  that  the  l  -  ip  controller  alone  can  not  define  a  general  formation. 
When  a  vehicle  is  constrained  by  more  than  one  neighbor  (or  obstacle)  in  the 
formation,  a  second  feedback  controller  is  needed  to  control  the  distances  of  the 
vehicle  from  two  neighboring  vehicles,  or  from  one  vehicle  and  an  obstacle.  This 
controller  is  called  the  l  -  l  controller. 

These  two  local  controllers  are  necessary  to  define  a  general  formation.  Usu¬ 
ally  the  vehicles  at  an  edge  of  the  formation  geometry  control  their  distance 
with  their  immediate  front  vehicle  using  the  l  -  ip  controller.  The  other  vehicles 
control  their  distances  to  their  immediate  front  and  side  vehicles  using  the  l  -  l 
controller.  This  is  necessary  so  that  a  vehicle  can  also  avoid  its  side  vehicle. 
Detailed  examples  are  presented  in  the  simulation  section  of  this  paper. 

3.1  Design  of  the  l  -  ip  controller 

In  Fig.  2,  a  system  of  two  neighboring  vehicles  in  the  formation  is  shown.  The 
vehicles  are  separated  by  a  distance  l\2  between  the  center  of  mass  of  vehicle 
1  and  an  arbitrary  point,  p,  on  vehicle  2.  The  arbitrary  point  has  a  distance  d 
with  the  center  of  mass.  Note  that  the  vehicles  are  not  physically  coupled  in  any 
way.  A  feedback  control  law  for  control  inputs  F2  and  Tjj  must  be  determined  to 
control  vehicle  2  such  that  the  desired  distance  and  view  angle  ipf2  to  vehicle 
1  are  maintained.  Therefore  the  outputs  of  the  control  system  are:  [lu,ipu]- 
The  state  variables  that  define  the  dynamics  of  vehicle  2  are:  The 
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Figure  2  \  l  -  tp  Control  Configuration 


state  variable-output  relations  of  this  control  system  are  obtained  by  writing 
the  kinematics  equation  for  l  -  ip  configuration. 

Acceleration  of  point  p  on  vehicle  2  can  be  written  in  two  ways,  once  with 
respect  to  center  of  mass  of  vehicle  1  and  once  with  respect  to  that  of  vehicle  2. 
The  resulting  equations  are  solved  for  the  highest  derivatives  of  the  outputs  In 
and  ipn  to  obtain  state  variable-output  relations. 

in  =  {y-2,  -  jli)  s«0  +  (*2  -  £i)  ca0  +  d§2  S7i 

~di>2  C71  +  Inoia  (4) 

Hu  =  777 [(i/2  -  i/i)  ca0  -  {x2  -  xi)  sc*0  +  d02  C71 

+dQ\  S71  -  2/1200  -  ln$i]  (5) 


where 


=  &i  +  1P12 
7i=0i+  ip  12  -  0-2 


The  goal  is  finding  a  control  law  for  the  two  inputs  [F2,  T2]  to  stabilise  the 
outputs.  Therefore,  the  input-output  equations  are  first  obtained  by  writing 
the  dynamic  equations  (2)  for  vehicle  2  and  substituting  the  results  into  the 
kinematics  equations  (4)  and  (5). 

li2  =  [fi  +  ^7 F2  C71  +  ^ Tid  S71]  (6) 

H12  =  k[u-  ^2  S71  +  ^T2d  c7x]  (7) 
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where 


fi  =  5^7  (/x  Ctto  +  f y  Stto)  +  —fed  S71  -  xi  ca0  -  y}  sa0 
C7i  +  h-zal 

U  =  ^rrr(-/x  s«o  +  /„  Mo)  +  ^fed  <=7i  +  sa0  -  yi  ca0 
+dO'i  S71  —  2ii 2 do  —  h'iSi 

Input-output  linearization  is  used  to  design  a  controller  based  on  the  input- 
output  equations  (6)  and  (7).  In  this  method,  an  asymptotically  stable  second 
order  error  dynamics  is  assumed  (A;  >  0): 

e'i  +  2Aie,'  +  A?  Cj  =0  i  =  1,2  (8) 

where  e\  and  e2  are  the  output  errors  defined  as: 

ei  =  In  ~  if 2  e2  =  ip  12  ~  ipn  (9) 

Now,  the  control  laws  are  derived  by  combining  Eqns.  (8)  and  (9),  substituting 
the  results  into  input-output  equations  (6)  and  (7),  and  solving  for  inputs  F2 
and  T2. 

F2  =  mn[(fi2  ~  2Aiei  -  Afe!  -  /;)  C71 

-  (^12 (fp\2  ~  2A262  -  A^e2)  -  U)  S71]  (10) 

T‘i  =  ~p[(/? 2  -  Mi*i  -  A?ci  -  /,)  s7l 

-  (luirpt 2  -  2A2e2  -  A^e2)  -  /,/,)  C71]  (11) 

The  distance  In  and  view  angle  ipn  in  the  l  -  ip  configuration  shown  in  Fig.  2 
asymptotically  converge  to  their  corresponding  desired  values,  because  the  con¬ 
trol  laws  (10)  and  (11)  guarantee  that  errors  vanish  as  time  approaches  infinity. 
But  02,  the  orientation  of  vehicle  2,  is  not  directly  controlled.  The  dynamics 
of  this  degree  of  freedom  when  others  have  been  stabilized  is  referred  to  as  the 
zero  dynamics  of  the  system  and  its  stability  has  to  be  investigated  separately. 

3.2  Zero  dynamics  stability  for  the  l  -  ip  controller 

In  this  section,  the  stability  of  the  zero  dynamics  is  proven  by  considering  the 
relation  between  the  controlled  outputs  and  the  orientation  of  vehicle  2.  This 
relation  is  obtained  by  the  velocity  analysis  of  the  l  -  ip  configuration  shown  in 
Fig.  2  as: 

ii2  =  [(h  -  Vi)  s«o  +  (X2  ~  ii)  cao  +  d02  S71]  (12) 

1P12  =  jjj[(y2  -  yi)  ca0  -  (i2  -  ii)  sau  +  d02  cji 

— (13) 
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Note  that  Z12  =  If 2,  ipvi  =  ipf2,  Z12  =  0,  and  ft  2  =  0,  after  the  controlled  out¬ 
puts  have  reached  the  steady  state.  These  conditions  are  applied  to  Eqns.  (12) 
and  (13)  and  the  results  are  solved  for  ft: 

ft  =  ^  (-W2  +  y\  eft  -  ft  sft  +  lf20 1  C71)  (14) 

where  v2  =  y2  eft  —  £2  S02  is  the  lateral  velocity  of  vehicle  2.  Equation  (14) 
describes  the  zero  dynamics  of  the  l  -  ip  controller.  This  equation  is  used  to 
analyze  the  stability  of  zero  dynamics  in  cases  of  circular  and  linear  motions. 

3.2.1  Circular  motion 

First,  the  stability  of  ft  is  analyzed  when  vehicle  1  has  a  circular  motion  with 
constant  linear  speed  sq  =  (uf  +  v(  )0  5.  For  a  circular  motion,  the  orientation 
of  vehicle  1  is  ft  =  wt  +  fto,  where  fto  is  its  initial  orientation  1.  The  velocity 
components  of  the  motion  of  vehicle  1  become: 

ft  =  si  eft  y  =  Si  sft  (15) 

Equation  (15)  is  substituted  in  Eqn.  (14)  to  obtain: 

02  =  J(-T*  +  «1  8(0!  -  02)  +  if c(0i  -  ft  +  i>f2))  (16) 

This  can  be  further  manipulated  to  obtain  the  simpler  form: 

02  =  3(/?ic(01-02+A)-wa)  (17) 

where  ft  and  ft  are  constants. 

ft  = 

A  change  of  variable  to  5 12  =  ft  —  ft  is  made  and  the  following  differential 
equation  is  obtained: 

*12  =  2  (w2  +  u)d  —  ft  C(5i2  —  ft))  (18) 

Note  that  vehicle  1  is  moving  on  a  circle  and  vehicle  2  is  maintaining  a  constant 
distance  with  vehicle  1.  Therefore,  vehicle  2  is  also  moving  on  a  circle.  By 
observing  the  dynamic  equations  (1),  one  can  conclude  that  for  such  a  motion 
v2  is  constant.  Therefore  all  parameters  in  Eqn.  (18)  are  constants,  and  one  can 
easily  show  the  asymptotic  stability  of  the  following  fixed  equilibrium  point. 

*12  =  arccos  +  &  (19) 

Thus  the  motion  of  vehicle  2  will  locally  converge  to  the  equilibrium  trajectory: 

05  =  0i  -  *12  (20) 
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3.2.2  Linear  motion 


The  stability  of  zero  dynamics  is  also  analyzed  when  vehicle  1  moves  on  a 
straight  line.  In  this  case,  the  velocity  components  of  vehicle  1  become: 

±i  =  ui  c#io  yi  =  ui  s0io  &i  =  0  (21) 


where  u i  is  the  linear  velocity  and  6\a  is  the  orientation  of  vehicle  1.  Substituting 
Eqns.  (21)  into  Eqn.  (14)  and  simplifying  results  in: 


02  =  j  (— ' '*>2  +  Ui  s(0lo  —  &2)) 
a 


(22) 


One  can  obtain  the  following  differential  equation  with  a  change  of  variable  to 


<^12  =  0io  —  &2'- 


<5l2  =  ^(«a  -  «i  sJ12) 


(23) 


Since  vehicle  1  is  moving  on  a  line  and  vehicle  2  is  maintaining  a  constant 
distance  with  vehicle  1,  vehicle  2  is  also  moving  on  a  line.  If  the  dynamic 
equations  (1)  are  simplified  with  this  assumption,  it  can  be  shown  that  for  a 
linear  motion  n2  is  zero.  Thus,  all  the  parameters  in  Eqn.  (18)  are  constant, 
and  linearization  of  (18)  can  easily  show  the  asymptotic  stability  of  the  following 
constant  equilibrium  point. 

Sel2  =  0  (24) 


Thus  the  motion  of  the  vehicles  will  locally  converge  to  the  equilibrium  trajec¬ 
tory: 

ei  =  010  (25) 


3.3  Design  of  the  l  -  l  controller 

In  Fig.  3,  a  system  of  three  vehicles  is  shown.  A  controller  must  be  designed  to 
stabilize  the  distance  of  vehicle  3  from  the  two  neighboring  vehicles.  Distances 
are  measured  from  the  centers  of  mass  of  vehicles  1  and  2  to  an  arbitrary  point 
on  vehicle  3,  which  is  offset  by  d  from  its  center  of  mass.  The  feedback  controller 
inputs  are  the  driving  force  and  the  steering  torque  of  vehicle  3,  Fj  and  Tj.  The 
desired  distances  lf3  and  to  vehicles  1  and  2,  respectively,  are  to  be  main¬ 
tained.  Thus  the  outputs  of  the  control  system  are:  [hs,  <23]-  The  state  variables 
that  define  the  dynamics  of  vehicle  3  are:  [2:3, 1/3,  #3].  The  state  variable-output 
relations  of  this  control  system  are  obtained  by  writing  the  kinematics  equation 
for  the  l  -  l  configuration. 

The  same  procedure  of  writing  the  acceleration  kinematic  equations  for  point 
p  that  was  introduced  in  l  -  rp  control  can  be  repeated  here.  These  kinematic 
equations  can  be  solved  for  the  second-order  derivative  of  I13  and  /2 3.  This  gives 
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Figure  3 :  l  -  l  Control  Configuration 


the  following  state  variable-output  equations. 


hi  =  (z/a  -  'iji)  sai  +  (x3  -  Xi)  cati  +  dffj  S72 

-ddl  cji  +  lvia{ 

(26) 

hi  =  (s/a  -  i h)  s«2  +  {'h  -  z2)  ca2  +  di):i  S7a 

-d§l  c7a  +  hsoil 

(27) 

where 

«i  =  0i+  ipn  Ji  =  0i  +  t/»ia  -  #3 

cr2  =  02  +  V>23  7a  =  02  +  i>rs  -  #3 

Since  the  goal  is  finding  a  control  law  for  the  two  inputs  [Fs,T2] 

to  stabilize  the 

outputs,  the  input-output  equations  are  needed.  These  equations  are  obtained 
by  writing  the  dynamic  equations  (2)  for  vehicle  3  and  substituting  the  results 

into  the  kinematics  equations  (26)  and  (27). 

=  h  +  072  +  ^2ad  S72 

(28) 

hi  -  h  +  7^7 F3  073  +  jy^T-jd  sy3 

(29) 
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where 


h  =  7^(fx  «*i  +  fy  SO!!)  +  —Jed  s72  -  Xi  cai  -  j/i  sai 

-dOl  c 72  +  lysaf 

h  =  ^77  fx  c«2  +  /y  s«2  +  ^—fed  s73  -  x2  c«2  -  2/2  sa2 

-Ml  C73  +  *23<*2 

A  controller  is  designed  for  input-output  equations  (28)  and  (29)  via  input- 
output  linearization.  The  output  errors  are  defined  as 

Ci  =  hs  —  lyj  =  hi  ~  fy  (30) 

and  an  asymptotically  stable  second  order  error  dynamics  is  assumed  (A;  >  0): 

-f-  2A£e£  +  Aifgj  =0  i  —  1,2  (31) 

Now,  the  control  laws  are  derived  by  combining  Eqns.  (30)  and  (31),  substituting 
the  results  into  input-output  equations  (28)  and  (29),  and  solving  for  inputs  Fi 
and  T-i- 


Fi  =  ~ 2X161  ~ A?ei  ~  fl)  873 

—  62 3  -  2X2e2  -  A^e2  -  f2)  372]  (32) 

Ti  =  j8(a?-ai)["fe  ~  2Ml  "  A"Cl  "  h)  C73 

+  (i2i  —  2A262  —  A3e2  —  f2)  C72]  (33) 

The  control  laws  (32)  and  (33)  guarantee  that  the  distance  lyi  and  hi  in  the  l  - 
l  configuration  shown  in  Fig.  3  asymptotically  converge  to  their  corresponding 
desired  values.  But  the  orientation  of  vehicle  3,  03,  is  not  directly  controlled  and 
its  response  after  the  outputs  have  converged  (the  zero  dynamics  of  the  system) 
has  to  be  investigated. 

3.4  Zero  dynamics  stability  for  the  l  -  l  controller 

In  this  section,  the  stability  of  the  zero  dynamics  is  proven.  The  velocity  analysis 
of  vehicles  1  and  3  in  l  -  l  configuration  results  in  the  following  kinematic 
equations,  which  describe  the  relation  between  the  controlled  output  hi,  the 
view  angle  ipyj,  and  the  orientation  of  vehicle  3. 

hi  =  [(j/3  -  Vi)  sai  +  (£3  -  ij)  cc*i  +  dSA  S72]  (34) 

i’n  =  ~  Vi)  -  (£3  -  £1)  sen  +  d&i  C72 

— (35) 
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After  the  controlled  outputs  have  reached  the  equilibrium,  In  =  In  =  l23i 
In  =  0,  and  in  =  0.  Note  that  these  equilibrium  conditions  also  imply  that 
ipn  becomes  stabilized  at  some  value  ipyS  and  1/73  =  0.  These  conditions  are 
applied  to  (34)  and  (35)  and  the  results  are  solved  for  63: 

03  =  ^  (-V3  +  Vi  <#s  -  +  If-J  1  C72)  (36) 

where  1)3  =  $3  c 9j  —  x-j  s0a  is  the  lateral  velocity  of  vehicle  3.  Equation  (36) 
describes  the  zero  dynamics  of  the  l  -  l  control  system.  This  equation  is  very 
similar  to  Eqn.  (14)  in  nature.  Thus  the  procedure  discussed  about  the  stability 
of  l  -  ip  controller  can  be  repeated.  It  can  be  shown  that  for  a  circular  motion  of 
the  group  of  three  vehicles  with  constant  speed,  where  9\  =  ut  +  Ow  and  0i  =  w, 
the  orientation  of  vehicle  3  converges  to  the  following  equilibrium  trajectory: 

%=9i-  Sen  (37) 

where 


Note  that  V3  is  constant  for  a  circular  motion,  and  sq  is  the  constant  linear 
velocity  of  vehicle  1.  Therefore  the  offset  5yS  is  constant.  Also  with  a  similar 
procedure  as  was  shown  for  the  l  -  ip  controller,  it  can  be  shown  that  when 
vehicles  1  and  2  are  moving  on  two  parallel  straight  lines  with  angles  01O  =  0 

with  respect  to  the  z-axis,  the  orientation  of  vehicle  3  converges  to  the  following 
equilibrium  trajectory: 

10  =  020  (39) 

4  Simulation  Results 

Numerical  simulations  show  the  effectiveness  of  the  controller  design  and  the 
accuracy  of  the  stability  analysis.  Three  simulation  examples  are  presented  in 
this  section.  In  these  simulations,  the  vehicles  are  assumed  to  be  identical.  The 
controller  parameters,  Ai  and  A2,  are  selected  to  be  0.4  for  all  l  -  tp  and  l  -  l 
controllers.  The  numerical  values  of  the  dynamic  parameters  of  the  vehicles  are 
as  follows  [10]: 

mu  =  200  kg  t»22  =  250  kg 
m-i-i  —  80  kg.rn2  dn  =70  kg/s 
d2 2  =  100  kg/s  da  =  50  kg.rn2 /s 
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Figure  4 :  l  -  ip  Control  Circular  Motion 
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Figure  5 :  l  -  ip  Control  Parameters 


Time  (sec) 

Figure  6 :  l  -  ip  Control  Orientation  Difference 
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Figure  7:  l  -  l  Control  Linear  Motion 

4.1  l  —  ip  controller 

Figure  4  shows  two  vehicles,  where  vehicle  2  is  commanded  to  keep  a  specified 
distance,  ly2  =  2.0  meters,  and  view  angle,  ipy2  =  tt/2  rad,  from  vehicle  1. 
Vehicle  1  is  moving  on  a  circle  with  a  radius  of  15  in  with  a  constant  linear 
velocity  of  9.42  m/s.  It  is  seen  that  vehicle  2  is  far  from  the  specified  formation 
at  the  beginning  of  the  motion,  but  it  maintains  the  formation  parameters  after 
a  while.  The  orientation  of  vehicle  2  is  shown  by  the  small  line  segments. 
Note  that  due  to  the  dynamics  of  the  vehicle,  the  orientation  is  not  necessarily 
tangent  to  the  path,  but  it  is  stabilized.  The  response  of  the  controller  outputs, 
[^12,  V’l'i],  is  shown  in  Fig.  5.  As  is  expected  from  Eqn.  (8),  the  error  dynamics  is 
asymptotically  stable  and  the  controller  outputs  converge  to  their  corresponding 
desired  values  asymptotically.  Figure  6  shows  the  difference  in  the  orientation 
of  the  two  vehicles,  6y2 ■  This  difference  becomes  a  constant  value  as  dictated 
by  Eqn.  (20). 

4.2  l  -  l  controller 

Three  vehicles  are  shown  in  Fig.  7.  Vehicle  3  is  commanded  to  keep  specified 
distances,  lyS  =  4.0  and  l23  =  4.0  meters,  from  vehciles  1  and  2,  respectively, 
vehciles  1  and  2  are  moving  on  a  straight  line  at  a  constant  linear  velocity  of 
1.4  m/s.  Note  that  vehcile  3  is  not  in  the  specified  formation  at  the  beginning 
of  the  motion.  The  figure  shows  that  it  maintains  the  formation  parameters 
after  some  time.  The  small  line  segments  show  the  orientation  of  vehicle  3. 
It  can  be  seen  that  the  orientation  error  is  stabilized  at  zero.  The  response 
of  the  controller  outputs,  [fis,l2s]j  is  shown  in  Fig.  8.  The  error  dynamics  is 
asymptotically  stable,  as  is  expected  from  Eqn.  (31).  The  difference  in  the 
orientation  of  vehcile  1  and  3,  Syj,  is  shown  in  Fig.  9.  This  difference  becomes 
zero  as  dictated  by  Eqn.  (39). 
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Figure  8 :  l  -  l  Control  Parameters 


Figure  9 :  l  -  l  Control  Orientation  Difference 
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Figure  10:  Six  Vehilces  in  a  Rectangular  Formation 
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Figure  11:  Six  Vehicles  in  a  Triangular  Formation 
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Vehicle 

Controller 

Follows 

1 

- 

a  predefined  trajectory 

2 

l-ip 

vehicle  1 

3 

l-l 

vehicles  1  &  2 

4 

l  -  ip 

vehicle  2 

5 

l-l 

vehicles  3  &;  4 

6 

l-l 

vehicles  3  &  5 

Table  1:  Formation  Structure  Setup 


4.3  General  formation  control 

The  designed  controllers  are  integrated  to  control  more  general  formations.  This 
section  presents  the  application  of  the  l  -  ip  and  l  -  l  controllers  with  multiple 
vehicles.  Figure  10  shows  six  vehicles  that  are  initially  in  a  rectangular  for¬ 
mation.  Table  1  summarizes  the  formation  control  structure.  The  same  six 
vehicles  are  shown  in  Fig.  11  in  a  triangular  formation.  Note  that  the  formation 
structure  that  is  defined  in  Table  1  is  still  applicable  for  this  formation.  The 
only  difference  between  the  two  formations  is  the  desired  values  of  the  formation 
parameters  [lyi^vA  all(i  Pistes  1  for  l -ip  and  l  -  l  controllers  respectively.  Two 
formation  change  scenarios  are  presented  based  on  this  formation  structure. 

In  the  first  simulation,  it  is  assumed  that  vehicle  1  is  commanded  to  move  on 
a  parabola  by  an  external  trajectory  planning  algorithm.  The  group  is  initially 
in  a  rectangular  formation  similar  to  Fig.  10,  and  is  commanded  to  form  a 
triangular  formation  as  shown  in  Fig.  11.  This  is  equivalent  to  changing  the 
desired  values  of  the  formation  parameters.  Figure  12  shows  the  motion  of  the 
six  vehicles  during  this  maneuver.  The  vehicles  are  at  their  initial  positions  at 
lower  left  corner  of  the  figure.  By  applying  the  local  controllers,  the  vehicles 
successfully  change  their  formation  and  direction  of  motion. 

In  the  second  simulation,  vehicle  1  is  moving  on  a  half-sine  trajectory  that 
is  determined  by  an  external  trajectory  planning  algorithm.  The  group  has  a 
triangular  formation  as  shown  in  Fig.  11  at  the  star  t  of  the  motion.  It  is  assumed 
that  the  group  has  to  form  a  rectangular  formation  similar  to  the  one  shown  in 
Fig.  10.  The  equivalent  desired  values  of  the  formation  parameters  are  changed 
accordingly.  The  motion  of  the  six  vehicles  during  this  maneuver  is  shown  in 
Fig.  13.  Once  again  the  local  controllers  successfully  change  the  formation  of 
the  group. 

5  Conclusions 

The  formation  control  of  an  arbitrary  number  of  vehicles  was  investigated.  Two 
local  control  laws  were  introduced  that  control  the  relative  positions  of  neigh¬ 
boring  vehicles  based  on  sensor  information.  Since  the  control  schemes  are  local, 
each  vehicle  has  to  have  information  about  only  one  or  two  of  its  neighbors,  de¬ 
pending  on  the  location  of  the  vehicle  in  the  formation.  The  dynamic  models  of 
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Figure  12:  Six  Vehicles  Changing  Formation 


Figure  13:  Six  Vehicles  Changing  Formation 
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the  vehicles  were  used  to  design  the  controllers.  Since  the  vehicles  are  underac¬ 
tuated,  the  stability  of  the  internal  dynamics  of  the  system  (orientation  of  the 
vehicle)  had  to  be  investigated.  It  was  shown  that  for  circular  and  linear'  motion 
of  the  formation,  internal  dynamics  of  the  vehicles  is  asymptotically  stable.  The 
effectiveness  of  the  control  algorithm  was  shown  by  numerical  simulations. 

Sensitivity  to  parameter  uncertainty,  local  and  global  obstacle  avoidance, 
autonomous  formation  planning,  and  robustness  to  failure  of  a  gr  oup  member 
are  interesting  topics  that  are  being  investigated.  Also,  an  experimental  setup 
is  being  designed  and  built  at  Center  for  Nonlinear  Dynamics  and  Control, 
Villanova  University. 
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